Listing of Claims: 



1. (currently amended) A system for estimating the position, speed and 
orientation of a vehicle (40), comprising: 

means for determining the components of two noncollinear constant unit 
vectors § b9 e b according to vehicle body axes; 

means for determining the components of said noncollinear constant unit 
vectors g t ,e, according to the Earth's axes; and 

means for determining the three components of the angular velocity & b of 

the vehicle in body axes[[.]]; 

ch a r a ct e r i z e d in that wherein the system comprises 

means for correcting said angular velocity & b with a correction u m and 

obtaining a corrected angular velocity cb h = & b +u & ; 

a module for integrating the kinematic equations (43) of the vehicle 
receiving the corrected angular velocity & b as input and providing the 

transformation matrix B for transforming Earth's axes into vehicle body axes and 

the orientation of the vehicle in the form of Euler angles 6 ; 

a synthesis module (4£) of the components in body axes of the two 
noncollinear constant unit vectors to provide an estimation of said noncollinear 
vectors in body axes g b9 e bi where said estimation is calculated as follows: 

g b = B S, 
e b =Be t 

a control module (44) implementing a control law to calculate said 
correction u m , where said control law is: 

Ua,=< T (g b xib+e b xe b ) [1] 

where a is a positive scalar, 

such that by applying this correction u a to the measured angular velocity & b and 
using the resulting angular velocity a> b =& b +u n as input to the module for 
integrating the kinematic equations, the latter are stable in the ISS sense and the 
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error in the estimation of the direction cosine matrix B and of the Euler angles 6 
is bounded. 

2. (currently amended) -A The system according to claim 1 , char a ct e riz e d i n 
that wherein said noncollinear unit vectors g,e are local gravity § and projection 
of the magnetic field on the plane perpendicular to gravity e . 

3. (currently amended) A The system according to claim 2, char a ct e r i z e d i n 
that th e wherein said means for determining the components of the two 
noncollinear constant unit vectors g b ,e b according to vehicle body axes include: 

an Inertial Measurement Unit (IMU) (24) including a group of at least three 
gyroscopes (211) and at least three accelerometers (212) located along the 
vehicle body axes; 

a magnetometer (22)-able to measure the Earth's magnetic field according 
to the vehicle body axes; 

static pressure (231) and differential pressure (232) sensors; 

two vanes (24) to measure the angles of attack (2 4 1) and side slip (2 4 2) ; 

an angular velocity acquisition and processing module (444 configured to 
acquire the angular velocity 3 b (t) and delay it to obtain a> b (t-r) ; 

a data acquisition and processing module (47) configured to acquire the 
specific force a b (t) measured by the accelerometers (212) , the static pressure 

p s (t) measured in sensor (231) , the differential pressure p d (t) measured in 

sensor (232) , the angle of attack d(t) measured in sensor (2 4 1) , the angle of 

sideslip Pit) measured in senso r (2 4 2) and the value of the Earth's magnetic 

field m b {t) measured in the magnetometer (22), delay them and process them to 

calculate the true airspeed v(/-r), the airspeed in body axes v b {t-r) as 

follows: 
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0 cos a cos P 

. usin/? 
v sin 5 cos P 



the numerical derivative of the airspeed in body axes v b {t-r) 



the local gravity in body axes g b as follows: 



g b {t-T) = v b {t-T) + a> b (t-r)xv b (t-T)-a b (t-T) 

and the projection of the Earth's magnetic field on the horizontal plane 
perpendicular to local gravity e(t-r) as follows: , 

e b (t -r) = m b (t-T)- m b (t - r) • g /* ~ T l . 




4. 



(currently amended) 



A The system according to claim 3, 



character i z e d i n that wherein the means for knowing the components of the two 
noncollinear constant unit vectors g t ,e t according to Earth's axes include: 

a GPS (Global Positioning System) receiver (2&); 
and in that the data provided by the GPS are acquired, processed and used in 
said data acquisition and processing module (47) to calculate the components of 
the two noncollinear constant unit vectors g n e t according to the Earth's axes. 

5. (currently amended) A The system according to claim 3, charact e riz e d i n 
that wherein the system includes a Savitzky-Golay filter (179) where v b% 

numerical derivative of v h , is calculated. 

6. (currently amended) A The system according to claim 1 including: 
means of acquiring data from a group of sensors (25, 231) located in the 

vehicle, providing position and speed according to Earth's axes P n V t ; 

means of acquiring data from another group of sensors (212) located in 
the vehicle, providing specific force a b in body axes; 

a navigation module where the navigation equations of the vehicle are 



integrated from the specific force a b and the direction cosine matrix B to 

obtain calculated position and speed in local axes and corrected in a 
Kalman filter to obtain estimated position and speed in local axes. 

7. (currently amended) A method for estimating the position, speed and 
orientation of a vehicle comprising: 

calculating the components of two noncollinear constant unit vectors g b ,e b 

according to vehicle body axes from measurements of sensors located in the 
vehicle according to the body axes of the latter; 

calculating the components of said noncollinear constant unit vectors 
g t9 e t , according to the Earth's axes from measurements of sensors located in the 
vehicle which provide position in local axes; 

measuring the three components of angular velocity & b of the vehicle in 
body axes; 

correcting the angular velocity & b with a correction u (0 and obtaining a 
corrected angular velocity & b = & b + u m ; 

integrating the kinematic equations of the vehicle, according to the 
corrected angular velocity co b and providing the transformation matrix B for 
transforming the Earth's axes into vehicle body axes and the orientation of the 
vehicle in the form of Euler angles 6 ; 

calculating an estimation of the components in body axes of the two 
noncollinear constant unit vectors g b ,e b , where said estimation is calculated as 
follows: 

it = 
e b = Be t 

obtaining the correction by means of the control law: 

=<r(& x £* +5 * x ^) [1] 

where a is a positive scalar, 
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such that upon applying this correction u (0 to the measured angular velocity <o b 

and using the resulting angular velocity cb b = 3 b + u e) as input to the module for 

integrating the kinematic equations, the latter are stable in the ISS sense and the 

error in the estimation of the direction cosine matrix B and of the Euler angles 6 
is bounded. 

8. (currently amended) A The method according to claim 7, charact o r i z o d i n 
thai wherein said noncollinear unit vectors g,e are local gravity g and projection 

of the magnetic field on the plane perpendicular to gravity e . 

9. (currently comprising) A The method according to claim 8, charact e r i z e d i n 
that i t compr i s e s further comprising : 

measuring specific force a b (t) , static pressure p s {t) , differential pressure 

p d (t) , angle of attack a(t) , angle of sideslip p{t) and the value of the Earth's 
magnetic field m b (t)\ 

calculating the true airspeed 6(t) from the differential pressure p d (i) and 
static pressure p s (t) measurements and from knowing the outside temperature 
at the initial moment T 0 ; 

calculating the airspeed in body axes as follows: 

0 cos a cos p 

£>sin P 
0 sin a cos P 



V 6 = 



delaying a time r the angular velocity cd b {t) , specific force a b {t) , magnetic 
field m b (t) and airspeed in body axes v b {t) ; 

calculating the numerical derivative of the airspeed in body axes 9 b (t - r) ; 
calculating the local gravity in body axes g b as follows: 

g b (t-T) = t b (t-T) + G) b (t-T)xv b (t-T)-a b (t-T))y t 

calculating the projection of the Earth's magnetic field on the horizontal 
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plane perpendicular to local gravity as follows: 

e b (t -r) = m b (t-T)- m b (t - r) ■ gbi [ " T) . 

\g b (t- T )\ 

10. (currently amended) A The method according to claim 9, charact e r i z e d i n 
that wherein the position in Earth axes P t is measured and from this 
measurement the components of the two noncollinear constant unit vectors 
g ( ,e { are calculated according to the Earth's axes. 

1 1 . (currently amended) -A- The method according to any of claims 9-4©, 
charact e r i z e d in that wherein v 6 , the numerical derivative of v b , is calculated in a 
Savitzky-Golay filter (1 79). 

12. (currently amended) A The method according to any of claims 7-44 
including: 

measuring position and speed in Earth-fixed axes P n V t ; 
measuring specific force a b in body axes; 

integrating the navigation equations of the vehicle according to the specific 

force a b and the direction cosine matrix B to obtain the calculated position 

and speed in local axes and they are corrected in a Kalman filter to obtain 
estimated position and speed in local axes. 
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